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The main system processor (1) generates position commands (Xsoll) 
that are received by a servo controller (2) that has a position 
regulator (21), a velocity regulator (22), a current regulator (23) and 
a thyristor drive stage (24) . The thyristor supplies power to a servo 
motor (25) driving a machine carriage or tool (26). An incremental 
encoder (27) provides position and velocity feedback and current 
feedback is employed around the thyristor. 

The system employs a stored dynamic model (3) that is assessed by 
the position command and generates an anticipated position value. This 
value is compared (4) with the measured position to check if the system 
positioning is within a predetermined tolerance. An indicator (41) is 
activated to signal an error. The signal is also fed back (42) to the 
processor for diagnostic purposes. A similar facility may be provided 
for velocity modelling (5) . 

ADVANTAGE - Dynamic monitoring of path errors using system model. 
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Die Erfindung betrifft die dynamische Regelkreisuberwa- 
Chung bei rechnergesteuerten Werkzeugmaschinen. An- 
hand eines diskreten Streckenmodells (3), das a!s Differen- 
zengleichung im Rechner (1) hinterlegt ist, werden Istwerte 
(XjgJ berechnet und mit den tatsachlichen Istwerten (Xjgj) 
verglichen. Bei Abweichungen, die ein bestimmtes Tole- 
ranzband uberschreiten, karth auf Fehler in der Strecke ge- 
schtossen werden. 
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Patentansprtiche 



^Ij^yi^erwachung von Antriebsregelkreisen bei rechnerge- 
steuerten Werkzeugmaschinen Oder Industr ierobotern , bei 
5 der 1st- und Sollwerte miteinander in Beziehung gesetzt 
sind, gekennzeichnet durch fol- 
gende Merkmale: 

a) es ist ein diskretes Streckenmodell (3) der betreffen- 
10 den Regelstrecke (2) im Rechner (1) gespeichert; 

b) der aus dem Sollwert (xg^^^^) der RegelgrbBe der 
Regelstrecke resultierende tatsSchliche Istwert (y^gt^ 
der RegelgrSfle und der aus dem Sollwert (YsqIi) 
RegelgroBe anhand des Streckenmodells geschStzte Ist- 

15 wert (y^s^) sind zu diskreten Zeitpunkten miteinander 
vergleichbar , 

c) eine Abweichting des tatsSchlichen Istv?ertes (xj^^^) 
vom geschSLtzten Istwert (^^j^gt^ ' vorgegebenes 
Toleranzband ( £ ) Uberschreitet , dient als Indiz f iir 

20 einen Fehler. 

2 . Oberwachung nach Anspruch 1, dadurch ge- 
kennzeichnet, da6 anhand von Teilmodellen 
der Strecke tatsSchliche und geschatzte Istwerte der 

25 betreffenden Teilstrecke (5) miteinander auf Fehler ver- 
gleichbar sind. 

3. Oberwachujag nach Anspruch 1, dadurch ge- 
kennzeichnet, daB Sollwerte (xg^j^^^) und 

30 errechnete zugehorige Istwerte (xj^g^) miteinander ver- 
gleichbar sind tmd a\if eine vergebbare Abweichiuig von- 
einander durch Veranderung der Geschwindigkeit der Soll- 
wertvorgabe einregelbar sind. 
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Unser Zeichen 



5 Uberwachung von Antriebsregelkreisen bei rechnerge- 
steuerten Werkzeugmaschinen oder Industrierobotern 



Die Erfindung bezieht sich auf eine Ubeirwachung von An- 
triebsregelkreisen bei rechnergesteuerten Werkzeugma- 
10 schinen oder Industrierobotern, bei der 1st- und Soll- 
werte miteinander in Beziehung gesetzt sind* 

Mit diesem Oberbegriff wird auf eine ttbervachungsanord- 
nung Bezug genommen, wie sie beispielsweise aus der 
15 DE-AS 27 29 372 bekannt ist. 

Es sind rechnergefiihrte numerisch gesteuerte Werkzeug- 
maschinen bekannt, bei denen von einem Lagemeflsystem in 
vorgegebenen Intervallen Teilistwerte erfafit, in den 

20 Rechner eingegeben und zu einem Gesamtistwert summiert 
werden, der mit einem Lagesollwert verglichen wird, wo- 
bei der sich beim Vergleich ergebende Schleppabstand in 
einen zyklisch ausgegebenen Drehzahlsollwert fiir die An- 
triebseinheit umgesetzt wird, Um Stbrungen zu erfassen, 

25 wird iiberwacht, ob der Schleppabstand einen vorbestimm- 
ten Wert Uberschreitet; ferner wird auch noch Uberwacht, 
ob das Verhaltnis von Drehzahlsollwert zu Teilistwert 
bestimmte Grenzen Uberschreitet (vgl* DE-AS 27 29 372), 

30 Mit derartigen Uberwachungen kann erfa8t werden, ob 
sich Istwerte zu weit von ihren zugehorigen Sollwerten 
entfernen, aber nicht oder nur sehr schwer, ob der tat- 
sachliche Istwert einen Verlauf im Hinblick auf eine 
Sollwertanderung hat, die mit dem zu erwartenden, d,h. 

35 im Regelfall gewUnschten und ftir den Normalbetrieb re- 
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prSsentatlven zeitlichen Verlauf ilbereinstimmt. 

Die Aufgabe der vorliegenden Erfindung besteht darin, 
eine betriebsmSBige dynamische Uberwachung der Antriebs- 
5 regelkreise zu schaffen, mit der sich a\xf einfache Wei- 
se erf assert last, ob sich die Istwerte zeitlich in vor- 
geschriebener Weise im Hinblick auf die entsprechenden 
Sollwerte andem. 

10 Diese Aufgabe wird erf indiangsgemSfi durch folgende Merk- 
male gelost: 

a) Es ist ein diskretes Streckemnodell der betreff enden 
Regelstrecke im Rechner gespeichert; 

15 b) der aus dem Sollvrert der RegelgrSfie der Regelstrecke 
resultierende tatsachliche Istwert der Regelgr53e 
und der aus dem Sollwert der RegelgrSBe anhand des 
Streckenmodells geschatzte zugehSrige Istwert sind 
zu diskreten Zeitpunkten miteinander vergleichbar , 

20 und 

c) eine Abweichung des tatsachlichen Istwertes vom ge- 
schatzten Istwert, die ein vorgebbares Toleranzband 
Uberschreitet, dient als Indiz ftir einen Fehler. 

25 Auf diese Weise konnen Fehler im Antriebssystem, z.B. 
ein unzuiassig abgenutztes Lager oder ein Fehler im Weg- 
meBsystem, erkannt xind ein entsprechendes StSrsignal aus- 
gegeben werden. 

30 Wie bemerkt, ist das Systemmodell als Diff erenzenglei- 
chtmg im Rechner hinterlegt, wobei die Modellordnung 
der gewtinschten Modellgenauigkeit anzupassen ist. Die 
Diff erenzengleichung kann bei Systenwamit konstanten Para- 
metem, wie z.B. Werkzeugmaschinen, einmal bei der Inbe- 

35 triebnahmephase (z.B. nach der Methode der kleinsten 
Quadrate) bestimmt werden. Falls das System zeitver- 
anderliche Parameter enthalt, wie z.B. bei Robotern 
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durch deren veranderliche Ausladung, kann das Modell 
durch ein on-line-Identif ikationsverf ahren fortlaufend 
korrigiert warden. Die ermittelten Parameter sind dann 
standig einer Plausibilitatskontrolle zu lanterziehen 
5 (z.B. Uberwachimg auf Grenzwerte)* 

Mit der vorstehend beschriebenen Methods ist nicht nur 
eine Systemiiberwachung moglich, sondem es ist auch eine 
betriebsmaflige Eingrenzxang des Fehlers moglich. Sei z.B. 

10 angenommen, dafl in einem kaskadierten Lagedrehzahlregel- 
system ein Fehler im Gesamtsystem erkannt wird, so kann 
dann anhand eines Streckenteilmodells der Drehzahlregel- 
strecke auch ermittelt werden, ob der Pahler in diesem 
Teil liegt. Auf diese Weise kann eine Systemdiagnose, 

15 z,B. von entfernten Leitzentralen her, vorgenommen war- 
den. 

Da das Modell die Strecke dynamisch nachbildet, kann 
das Modell auch zur KonturenUberwachung verwendet wer- 
20 den, d.h. zur Oberwachiing, ob die Bahn des Werkzeuges 
am zu fertigende^ WerkstUck innerhalb eines vorgeschrie- 
benen Toleranzbandes verlauft, 

Regelxangstechnisch wird dies dadurch erreicht, dafl ent- 
25 weder das Programm vorab simuliert wird, oder jeweils 
betriebsmaflig kurz vorher - schneller als in Echtzeit - 
simuliert wird \ind UberprUft wird, ob der zu erwartende 
Istwert zu weit vom gewilnschten Sollwert abweicht. Falls 
dies der Fall sein sollte, kann dann z.B. in der nach- 
30 folgenden wirklichen Bearbeitung an den betref f enden 
Stellen die Bahngeschwindigkeit verringert werden. 

Anhand eines in der Zeichnung dargestellten AusfUhrungs- 
beispiels sei die Erfindung nSher erlautert; 
35 es zeigen: 

Figur 1 ein Schaltbild der Uberwachungsanordnung, und 
Figur 2 den zeitlichen Ablauf der ttberwachting. 
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Bei der in Figur 1 schematisch umrandet gezeichneten 
Regalstrecke 2 werden Lagesollwert Xg^^^, der aus elner 
Rechnersteuerung 1 stammt und Lageistwert Xg^, der von 
einem mit dem Antriebsmotor 25 gekuppelten Vegistgeber 
5 27 stammt, miteinander in einem Lageregler 21 verglichen 
und zxir Bildung des Drehzahlsollwertes Hg^^^ benutzt. 
Dieser Drehzahlsollwert J^s^^i di®^^* zusammen mit dem vom 
Geber 27 ebenf alls abgeleiteten Drehzahlistwert n^^g^ 
zur Bildiang des Stromsllwertes ^^soll Drehzahlregler 

10 22. Stromsollwert isoii Stromistwert i^g^ im Anker- 
kreis der Maschine 25 werden miteinander verglichen xmd 
in einem Stromregler 23 zur Bildxmg des Steuersignals 
fUr ein Thyristorstellglied 24 benutzt, das seinerseits 
die Maschine 25 entsprechend speist. Die Maschine 25 

15 dient z.B. zum Vorschub eines schematisch angedeuteten 
Werkzeugschlittens 26. 



Regelstrecken mit derartigen kaskadierten Regelkreisen 
\inter Einbeziehung einer Rechnersteuenmg sind bekannt 

20 (vgl. z.B. die DE-AS 27 29 372), wobei in diesem Zu- 
sammenhang noch bemerkt sei, daB nur der Einfachheit 
halber Telle der Strecke, wie Lageregler und Drehzahl- 
regler, als diskrete Bausteine dargestellt sind. In 
Wirklichkeit kSnnen auch diese Bausteine im Rechner 1 

25 integriert sein. 

Zusatzlich ist noch in der Rechnersteuerung 1 ein Modell 

der eingangs beschriebenen Regelstrecke 2 gespeichert. 

Dieses Modell 3 ist der Anschaulichkeit halber besonders 

30 herausgezeichnet. Wie ersichtlich, wird diesem Modell 

der Regelstrecke ebenf alls der jeweilige Lagesollwert 

^Soll 2^g®^*i^*- Anhand des Modells 3 der Regelstrecke 

wird hieraus der zu erwartende Istwert 1 . berech- 

xsx 

net, und zwar z.B. nach folgender Beziehung: 
35 $i3^ (k) = ax^3^ (j^^^j + bxsoii 

wenn die Regelstrecke dvirch ein VerziSgerungsglied erster 
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Ordnung approximiert wird. 

Hierbei ist mit k der Wert zxim diskreten Zeitptinkt und 
mlt k-1 der betreffende Wert zum diskreten Abtastzelt- 
5 punkt vorher bezeichnet. Die Grciflen a und b sind Para- 
meter, die sich aus dem jeweiligen System ergeben. 

In Worten ausgedirUckt : es wird also der Jeweils zu er- 
vartende Istwert aus dem Istwert zum vorhergehenden Ab- 
10 tastzeitpiinkt xmd dem vorliegenden Sollwert zum vorher- 
gehenden Abtastzeitpunkt bestimmt. 

Dieser berechnete (geschatzte) Istwert ^^3^ wird mit 
dem zugehorigen tatsachlichen Istwert x^g^ in einem Bau- 

15 stein 4 verglichen und festgestellt, ob die Differenz 
innerhalb eines vorgeschriebenen Toleranzbandes der 
Breite £ liegt. Falls der tatsachliche Istwert und der 
zu erwartende Istwert zu weit auseinanderklaff en, wird, 
wie durch die Leuchte 41 angedeutet, ein Fehlersignal 

20 ausgegeben. Gleichzeitig wird dieser Fehler Uber die 
Leitung 42 in die Rechnersteuerung 1 zurtickgemeldet und 
fur weitere Oberwachungs- und DiagnosemaSnahmen benutzt. 

Falls die Abweichung kleiner als ein vorgeschriebenes 
25 Toleranzband 6 ist, so werden in nachf olgenden Schrit- 
ten die Rechenwerte aktualisiert und erneut wieder der 
nachste zu erw£u*tende Istwert berechnet. Der zeitliche 
Ablauf dieses Verfahrens ist aus Figur 2 nochmals er- 
sichtlich, 

30 

Wie bereits bemerkt, kann die vorstehend beschriebene 
Oberwachung nicht nur zur Aufdeckung von Fehlem im 
Gesamt system wahrend des Betriebes verwendet werden, 
sondern auch urn betriebsmaSig eine Diagnose durchzu- 
35 fUhren. Beispielsweise ist es mSglich, wie durch das 
Bezugszeichen 5 angedeutet, ein Teilmodell der Dreh- 



9. 3A08173 
->^- VPA 84P 3 0 7 7 DE 

zahlregelstrecke herzustellen imd hier das Verhaitnis 
vom geschatzten n^g^ zum tatsachlichen Istwert n^^^^ 
ebenfalls zu tiberprilfen. 
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